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Calibrating a sensor system involves detecting sensor data as static or quasi- 
static objects taking into account object movement, feeding data to 
calibration unit for correction 
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Abstract of DE1 9982997 



The method involves detecting the data from the 
sensor as static or quasi-static objects taking into 
account the movement of the vehicle (1 ) itself 
and feeding the data to a calibration unit. The 
deviation between the current measured data 
from the data of a model of the object (6) is 
determined as an error vector and is evaluated to 
correct the data towards a deviation minimum. 
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@ Verfahren zur Kalibrierung eines Sensorsystems 

(g) Es wird ein Verfahren zur Kalibrierung eines Sensorsy- 
stems vorgeschlagen, mit dem eine Erfassung und Aus- 
wertung von Objekten im Kursverlauf eines Fahrzeuges 
(Ddurchgefuhrtwird. Beidem Verfahren werden mit dem 
Sensorsystem (2, 3, 4, 5) charakteristische Daten der Ob- 
jekte (6) erfasst und die Daten, die unter Berucksichtigung 
der Eigenbewegung des Fahrzeugs (1) als ruhende oder 
quasi ruhende Objekte (6) erkannt werden, einer Kalibrie- 
rungseinheit (7) zugefuhrt. In der Kalibrierungseinheit (6) 
werden die Abweichung der aktuell gemessenen Daten 
von Daten eines Modells der Objekte (6) als Fehlervektor 
ermittelt (25; 35) un zur Korrektur der Daten des Modells 
in Richtung auf eine Minimierung der Abweichung heran- 
gezogen (27, 26; 36, 37). 
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Beschreibung 
Stand derTechnik 

Die Erfindung betrifft ein Verfahren zur Kalibrierung ei- 
nes Sensorsystems, insbesondere eines Bildverarbeitungs- 
systems, nach der Gallung des Hauptanspruchs, 

Es ist an sich bekannt, dass Bildaufnahme- und andere 
Sensorsysteme als ein Baustein eines Fahrzeugsicherheits- 
systeras im StraBenverkehr angewendet werden. Hierbei 
werden standig Informationen uber den Abstand und die Re- 
lativgeschwindigkeit des Fahrzeuges im Verhaltnis zu ande- 
ren Objekten, d. h. anderen Fahrzeugen und zu den StraBen- 
gegebenheiten, veraibeitel. Die Bildaufnahmesysleme und 
ggf. auch Radarsensoren werden zur Messung geometri- 
scher GroBen im Fahrzeugumfeld verwendet, wobei die Ra- 
darsensoren fiir sich gesehen beispielsweise aus der 
DE4242 700A1 bekannt sind. Mit dieser bekannten An- 
ordnung kann beispielsweise eine Geschwindigkeitsrege- 
lung im Fahrzeug derarl erweiterl werden, dass die Fahrge- 
schwindigkeit an langsamere vorausfahrende Fahrzeuge an- 
gepassi wird, wenn diese von den Sensorsystemen im vor- 
aussichtlichen Kursbereich des Fahrzeugs erfasst werden. 
Der Kursbereich kann dabei beispielsweise mit Hilfe von 
Gierraten-, Lenkwinkel-, Querbeschleunigungssensoren, 
iiber die Radgeschwindigkciten, oder auch mit den erwahn- 
ten Bildverarbeitungs- oder mit Navigationssystemen be- 
stimmt werden. 

Fiir eine einwandfreie Funktion des Systems ist im Prin- 
zip eine vorherige Kalibnerung des Sensorsystems oder der 
Einzelsensoren im Fahrzeugumfeld zur anschlieBenden ge> 
nauen Messung geometrischer GroBen wie Langen, Ge- 
schwindigkeiten erforderlich, die vor oder nach Einbau der 
Sensoren ins Fahrzeug in laborahnlicher Umgebung erfolgt. 
Die verschiedenen Kalibrierungsverfahren erfordem in der 
Regel eine gezielte Bewegung der Sensoren bzw. der von 
der Sensorik erfaBten Objekte. Haufig ist sogar die Betrach- 
tung eines speziellen Kunstobjekles erforderlich, das ent- 
sprechend als Kalibrierfeld bezeichnet wird. Um eine dauer- 
hafte Funkiionssicherheit zu gewahrleisten ist auch eine 
spatere wiederhoile KontroUe der Kalibrierung auf mogli- 
che Veranderungen notwendig, die sehr aufwendig sein 
kann. 

Fur sich gesehen ist aus der EPO 602 013 Bl bekannt, 
dass zur Kalibrierung eines Koppelnavigationssystems Um- 
gebungsinfonnationen, die beispielsweise aus einer Slra- 
Benkarte bekannt sind, herangezogen werden. Hierbei wer- 
den Informationen Uber den eigenen Fahrzeugzustand in 
Verbindung mit den aus der Karte bekannten Umgebungsin- 
formationen verarbeitet. 

Vorteile der Erfindung 

Ein Verfahren zur Kalibrierung eines Sensorsystems, mit 
dem cine Erfassung und Auswertung von Objekten im Kurs- 
verlauf eines Fahrzeuges durchgefiihrt wird, ist erfindungs- 
gemaB so aufgebaut, dass mit dem Sensorsystem in vorteil- 
haftcr Weisc charakteristische Daten der Objekte, cin- 
schlieBlich der Fahrbahn, erfasst werden und die Daten, die 
unter Beriicksichtigung der Eigenbewegung des Fahrzeugs 
als ruhcnde oder quasi ruhcnde Objekte erkannt werden, ei- 
ner Kalibrierungseinheit zugefuhrt werden. In dieser Kali- 
brierungseinheit werden die Abweichung der aktuell gemes- 
senen Daten von Daten eines ModcUs der Objekte als Feh- 
lervektor ermittelt und zur Korrektur der Daten des Modells 
in Richtung auf eine Minimierung der Abweichung, z. B. 
mit einem iterativen Verfahren, herangezogen. 

Mit der Erfindung kann in besonders vorteilhafter Weise 



eine automatische Kalibrierung eines eingangs beschriebe- 
nen Sensorsystems und dariiber hinaus eine spatere automa- 
tische Uberpriifung einer einmal gewonnenen Kalibrierung 
durchgefiihrt werden. Hierzu sind auBer der an sich bekann- 
5 ten Sensorelemente in der Fahrzeugumgebung und einer 
Auswerte- bzw. Kalibrierungseinheit keine weiteren Hilfs- 
mittel erforderlich. 

Auch speziell durchgefuhrte Bewegungen des Fahrzeugs, 
die bislang eigens zum Zweck der Kalibrierung duichzufah- 
ren waren, sind verzichtbar, da die erfindungsgemaBe Kali- 
brierung vielmehr die Eigenbewegung der Fahrzeuge im 
Betrieb sowie das Wissen nutzt, daB Objekte der dreidimen- 
sionalen Welt haufig starr sind, bzw. sich ganzheitlich bewe- 
gen und die Kalibrierung der Sensoren uber einen langeren 
Zeitraum stabil ist. Hierbei ist die Kalibrierung der Sensorik 
quasistationar, d. h. allenfalls langsam veranderlich. Auch 
heuristische Annahmen uber typisches Verhalten anderer 
Verkehrsteilnehmer (z. B. Spurhalten), die in praktischen 
Anwendungen zu Fehlfunktionen fiihren konnen, sind fiir 
dieses Verfahren nichl erforderlich. Eine wesentliche Eigen- 
schaft der Erfindung ist somit, dass eine Kalibrierung mog- 
lich wird, welche die messbaren GroBen moglichst gut er- 
fasst. Die Forderung nach einer sog. wahren Kalibrierung, 
wie sie bei Laborkalibrierungen gestellt wird, ist hier nur 
zweiU:^gig. 

Fertigungstechnisch ist dariiber hinaus der Einbau unkali- 
brierter Sensoren besonders vorteilhaft, da die Kalibrierung 
eines Sensors oftmals empfindlich gegen mechanische oder 
thcamische Beanspruchung ist. Somit ist nicht nur die Ferti- 
gung vereinfacht, sondem es ist auch eine spatere Beriick- 
sichtigung von Einflussen des Einbaus oder von anderen 
Veranderungen der Sensorik, bzw. des Fahrzeugs, auf die 
Kalibrierung auf einfache Weise durchfiihrbar. Dariiber hin- 
aus kann die Kalibrierung auch jederzeit uberpruft werden. 

Nach einer besonders vorteilhaften Ausfuhrung des erfin- 
dungsgemaBen Verfahrens wird in einer Initialisierungs- 
phase mit vorgebbaren Parametem eine erste Erfassung der 
Objektdaten vorgenommen, die als Modelldaten gespeichert 
werden. In alien zyklisch darauf folgenden Messungen wer- 
den die jeweils aktuellen Objektdaten mit den zuvor erfass- 
ten gespeicherten Modelldaten zur Gewinnung des jeweili- 
gen Fehlervektors in der Kalibrierungseinheit verarbeitet. 

Wahrend der Verarbeitung der Daten in der Kalibrie- 
rungseinheit werden die jeweils aus den vorherigen Messun- 
gen wiederkehrenden Objektdaten ausgewahlt, wobei nicht 
wieder gefiindene Objektdaten geloscht sowie jeweils neu 
hinzugekommene Objektdaten aufgenommen werden. Die 
Objektdaten, die nach mehrmaligen Messungen aus unter- 
schiedlichen Positionen des Fahrzeugs heraus eine Veridei- 
nerung des jeweiUgen Konfidenzintervalls aufweisen, wer- 
den als zu einem ruhenden oder quasi ruhenden Objekt ge- 
horenden Daten gekennzeichnet. 

Bei dem erfindungsgemaBen Verfahren kann dariiber hin- 
aus auch aus aufeinanderfolgenden Objektdaten eine iiber- 
cinstinmiendc Relativgeschwindigkeit von Objekten und 
daraus auch die Eigenbewegung des Fahrzeugs ermittelt 
werden. Die Objektdaten, die einem Objekt mit dieser glei- 
chcn Relativgeschwindigkeit zuzuordnen sind, konnen da- 
bei als zu einem ruhenden oder quasi ruhenden Objekt gehd- 
renden Daten gekennzeichnet werden. In vorteilhafter Weise 
kann als Eigenbewegung des Fahrzeugs z. B. auch cine Ro- 
tationsbewegung des Fahrzeuges durch Nickbewegungen 
und/oder durch Kurvenfahrten herangezogen werden. 

Die Ergebnisse der Kalibrierung eines Sensors des Sen- 
sorsystems konnen auf einfache Weise auf einen oder meh- 
rere weitere Sensoren am Kraftfahrzeug zur Kalibrierung 
auch dieser Sensoren iibertragen werden. Mit dem erfin- 
dungsgemaBen Verfahren ist somit eine gemeinsame Kali- 
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brierung der meisten Fahrzeugsensoren nach dem Einbau 
moglich, ohne spezielle Randbedingungen zu erfordem. Ins- 
besondere die Kombination von Sensoren, wie Kamera, Ra- 
dar, Radsensor, Beschleunigungssensor ist hier vorteilhaft; 
aber auch eine Anwendung in Zusammenhang mit Lidar- 
Oder Ultraschallsensoren ist moglich. 

Fiir den Fall, dass der oder die Sensoren des Sensorsy- 
stems widerspriichliche Messdaten erstellen, kann beispiels- 
weise eine Signalisierung an eine Auswertednheit oder an 
den Fahrer dcs Fahrzcugs erfolgen. 

Die Edindung dient somit in vorteilhafter Weise der 
DurchfQhrung einer Kalibrierung mit gutem Eigebnis ohne 
eine spezielle Kalibrieranordnung oder Kalibrieibewe- 
gungsfolge zu erfordem. Das Sensor- bzw. Auswertesystem 
kann sich hierbei vollstandig oder weitgehend selbsttatig ka- 
librieren und die Genauigkeit und Zuverlassigkeit seiner 
Kalibrierung bestimmen. Parameter, die nicht oder noch 
nicht kalibriert sind, sind durch eine unendliche Ungenauig- 
keit gekennzeichnet. Insbesondere bemerkt das vorgestellte 
erfindungsgemaBe Verfahren grobe Veranderungen der Ka- 
librierung, die z. B. aufgrund thermischer oder mechani- 
scher Verschiebungen moglich sind. 

Besonders vorteilhaft kann die Erfindung angewendet 
werden, wenn das Sensorsystem ein Bildaufnahmesystem 
ist, bei dem mittels einer elektronischen Kamera mit nichtli- 
nearer Wandlerkennlinie in den Aufnahmeintervallen je- 
weils seriell Bildpunkte erfasst und ausgewertet werden. 
Viele herkommliche Bildauftiahmeverfahren fiihren die Ka- 
merakalibrierung uber den Umweg der sog. Fundamental- 
matrizen aus und sind deshalb auf eine zeitgleiche Auf- 
nahme der Bildelemente (kubisches Bildraster) und syn- 
chrone Sensordaten angewiesen. Das erfindungsgemaBe 
Verfahren arbeitet hingegen auch mit einem beliebigen Auf- 
nahmezeitpunkt dereinzelnen Bildpunkte und mit asynchro- 
nen Sensordaten. Somit ermoglicht das Verfahren insbeson- 
dere die Kalibrierung von hochauflosenden Mdeokameras 
mit nichtlinearer Kennlinie, welche in der Regel ihrc Bild- 
punkte seriell aufhehmen. 

Diese und weitere Merkmale von bevorzugten Weiterbil- 
dungen der Erfindung gehen auBer aus den Anspriichen 
auch aus der Beschreibung und den Zeichnungen hervor, 
wobei die einzelnen Merkmale jeweils fur sich allein oder 
zu mehreren in Form von Unterkombinationcn bei der Aus- 
fUhningsform der Erfindung und auf anderen Gebieten ver- 
wirklicht sein und vorteilhafte sowie fiir sich schutzfahige 
Ausfuhrungen darstellen konnen, fur die hier Schutz bean- 
sprucht wird. 

Zeichnung 

Das erfindungsgemaBe Verfahren zur Kalibrierung eines 
Sensorsyslems wird anhand eines Ausfuhrungsbeispiels bei 
der Anwendung des Verfahrens in einem Bildverarbeitungs- 
system, zur Auswertung von Objekten im Kursverlauf eines 
Fahrzeuges, in der Zeichnung erlautert. 

Es zeigen: 

Fig. 1 eine Skizze eines Fahrzeugs mil einem Sensor und 
einem Auswerte- und Kalibrierungssystem fiir die Anwen- 
dung mit einer Vielzahl von Einzelsensoren einschliefilich 
eines Bildaufnahmesystems; 

Fig. 2 eine erste Ablaufskizze der Kaiibrierungsschritte; 

Fig. 3 eine zweite Ablaufskizze der Kaiibrierungsschritte 
und 

Fig. 4 eine Darstcllung eines Lochkameramodells zur Er- 
lauterung der theoretischen Zusamraenhange bei der Gewin- 
nung eines Fehlervektors im Kalibrierungs verfahren. 
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Beschreibung des Ausfuhrungsbeispiels 

Fig. 1 zeigt eine mogliche Ausgestaltung eines Sensorsy- 
slems zur Durchftihrung einer Selbstkalibrierung der Sen- 

5 sorelemente, das in ein System zur Erfassung des Fahrzeug- 
umfelds in einem Fahrzeug 1, wie in der Beschreibungsein- 
leitung erwahnt, integriert ist. In der Fig. 1 sind hier nur bei- 
spielhaft als Sensoren eine elektronische Kamera als Bild- 
aufhahmesensor 2, ein Radarsensor 3, ein Beschleunigungs- 

10 sensor 4 und weitere Radsensoren 5 daigestellt. Diese Sen- 
soren 2 bis 5 konnen, wie aus der Fig. 1 mit den Abstrahlfel- 
dem und den Pfeilen fur die zu erfassenden mechanischen 
GroBen angedeutet, auf die Erfassung der Bewegung des 
Fahrzeugs 1 und des vorderen Fahrzeugumfelds ausgerich- 

15 tetsein. 

Bei anwendungstypischen Gegebenheiten befinden sich 
im Erfassungsbereich, bzw, im Fahrzeugumfeld Objekte 6 
oder sogar Gruppen von Objekten 6, die sich iiber einen lan- 
geren Betrachtungszeitraum nicht verformen, sondem sich 

20 allenfalls als Ganzes bewegen. Beispielhaft konnen hierfur 
insbesondere die Fahrbahn, die Leitplanken oder unter Um- 
standen auch weitere Fahrzeuge genannt werden. Die mit 
den Sensoren 2 bis 5 gewonnenen Daten werden beim Aus- 
fiihrungsbeispiel nach der Fig. 1 einer oder mehreren Aus- 

25 werteeinheiten 7 zugefuhrt, welche auch eine Kalibrierungs- 
einheit bcinhalten und die Informationen iiber die Fahrzeug- 
umgebung auswerten und Kalibrierung durchfiihren. Die 
Auswerteeinheit 7 ist in der Regel ohnehin zur Ermittlung 
von Fahrzeugumfeldinformation vorhanden und kann daher 

30 zur Bestimmung der Kalibrierungsparameter mitverwendet 
werden. 

Die Auswerteeinheit 7 benotigt fiir die Durchfuhrung der 
Sensorkalibrierung Objektdaten, die einem Speicher 8 ent- 
nonunen werden konnen. In der Auswerteeinheit 7 wird mit 

35 der Auswertung der Objektdaten die jeweils im Speicher 8 
befindliche Kalibrierungsinfonnation in einer weiter unten 
noch naher erlauterten Art und Weise verbessert. Die von 
der Auswerteeinheit 7 unter Zuhilfenahme der Kalibrierung 
berechnete Information iiber das Fahrzeugumfeld wird dann 

40 zur Beeinflussung des Fahrzeugs 1 iiber eine Aktorik 9 um- 
gesetzt und/oder informativ an den Fahrer des Fahrzeugs 1 
uber eine Mensch-Maschine Schnittstelle 10, z.B. einen 
Lautsprecher oder ein Display, weitergegeben. Die Aktorik 
9 kann hierbei z. B. ein Stellsignal fiir die Fahrzeugbremse 

45 verarbeiten. 

Anhand Fig. 2 sind mogliche Verfahrensschritte bei der 
Durchfuhrung der Selbstkalibrierung des Sensorsystems im 
Fahrzeug 1 nach der Fig. 1 veranschaulicht, Hierbei werden 
die von den Sensorelementen 2 bis 5 gemessene GroBen ei- 

50 ner realen Welt, dargestellt durch die Blocke 20 und 21, so- 
genannten modellierten GroBen, dargestellt durch die 
Blocke 22 und 23, gegeniibergestellt. Die Differenz zwi- 
schen den gemessenen GroBen und den modellierten Gro- 
Ben, ermittelt im Block 24, bildet im Block 25 einen Fehler- 

55 vektor. Die Durchfiihrung der Kalibrierung innerhalb der 
Auswerteeinheit 7 erfolgt hierbei so, dass der Fehlervektor 
moglichst klein wird, d. h. die Modellwelt der realen Welt 
moglichst gut entspricht. 
Die aus den Objektdaten der Sensoren 2 bis 5 gewonnene 

60 Kalibrierungsdaten bilden gemeinsam mit Modelldaten der 
parametrischen Modellwelt, entsprechend der Beschreibung 
des Fahrzeugumfeldes, auch einem Parametervektor, der in 
einem Block 26 abstrakt gezeigt ist. Das Modell beinhaltet 
dabei neben der parametrischen Beschreibung der Welt auch 

65 die Abbildung der Welt auf durch die Sensorelemente 2 bis 5 
messbaren GroBen. Fiir das Beispiel der Anwendung einer 
Kamera als Bildaufnahmesensor 2 ist dies die Projektion der 
Welt auf die Bildfoige. Die messbaren GroBen werden dann 
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sowohl aus der parametrischen Modellwelt bestimrnt als 
auch durch das Sensorelement 2 gemessen. Die Differenz 
dieser beiden Besiimmungen der messbaren GroBen wird zu 
einem Fehlervektor gruppiert (Block 25). Der Parameter- 
vektor in Block 26 wird dann durch geeignete Verfahren, die 5 
in einem Block 27 gekennzeichnet sind, so eingestellt, dass 
der Fehlervektor minimal wird, d. h. er wird deran mini- 
miert, dass die tatsachlichen Messungen und die durch das 
Modell in Verbindung mit dem aktuelien Parametervekior 
bcstimmten GroBen moglichst gut ubereinstimmen. lO 

Fiir die Durchfuhning eines solchra, fiir sich bekannten, 
Minimierungsverfahrens istein einfaches Kriterium fiir cine 
gute tibereinstimmung der GroBen beispielsweise die Qua- 
dratsumme der Abweichungen. £in hinreichend gutes £r- 
gebnis des Minimierungsverfahrens kann beispielsweise 15 
durch ein sog. Least-Square- Verfahren gefunden werden 
Oder es konnen auch weiterhin andere robuste Schatzverfah- 
ren sowie ein sog. Extended Kalman Filter bzw. ahnliche 
Ansatze verwendet werden. Alle diese, fiir sich gesehen be- 
kannten, Verfahren erlauben die Besdmmung der Genauig- 20 
keit und Zuverlassigkeit von Parametem und Messungen. 

Dem erfindungsgemafien Verfahren llegi, wie oben er- 
wahnt, die Annahme zugrunde, dass slarre Objekte 6 oder 
Gruppen solcher Objekte 6 im Fahrzeugumfeld existieren, 
Ihre Bewegung laBt sich daher durch drei Rotationsparame- 25 
ter und drei Translationsparameter vollstandig beschreiben. 
Weiterhin wird angenommen, dass sich zumindest manche 
dieser Objekte 6 relativ zum Fahrzeug 1 bewegen, beispiels- 
weise aufgrund der Eigenbewegung des Fahrzeugs 1. Diese 
Voraussetzungen sind haufig genug erfullt, so dass eine Be- 30 
rechnung oder Uberpriifung der Kalibrierung in kurzen In- 
tervallen moglich ist. 

Fig. 3 zeigt ein weiteres mbgliches RuBdiagramm zur 
Durchfuhrung des erfindungsgemafien Verfahrens hinsicht- 
lich der Auswertung der Objektdaten, welches im Zusam- 35 
menhang mit einem sog, Lochkameramodell anhand Fig. 4 
erlautert werden soli. Anhand des in der Fig. 3 dargestellten 
Russdiagramms soil eine einfache Ausfuhrung der Auswer- 
tung der Objektdaten nachfolgend dargelegt werden. Hier- 
bei umfasst das zugrunde liegende Sensorsystem notwendi- 40 
gerweise nur eine Kamera (Sensor 2) und den Radarsensor 
3. Auf die nahere Erlauterung des Russdiagramms nach der 
Fig. 3 wird nach dner Beschreibung der Fig. 4 eingegangen. 

Die Fig. 4 stellt beispielhaft ein einfaches bekanntes Ab- 
bildungsmodell fiir den Sensor 2 als sog. Lochkameramo- 45 
dell dar und dient dabei lediglich der BegrifiTsdefinition. Die 
Kalibrierparameter der Sensoren 2 und 3 werden gemein- 
sam mit ModellgroBen der parametrischen Modellwelt als 
Beschreibung des Fahrzeugumfeldes, wie anhand der Fig, 2 
erlautert, in einem Parametervektor zusammengefaBL Das 50 
Modell nach der Fig. 4 beinhaltet neben der parametrischen 
Beschreibung der Welt auch die Abbildung der Well auf die 
mit den Sensoren 2 und 3 messbaren GroBen. Fiir das Bei- 
spiel der Kamera 2, bzw. der Lochkamera nach der Fig. 4, ist 
dies die Projeklion der Well auf die Bildfolge. Die messba- 55 
ren GroBen werden dann sowohl aus der parametrischen 
Modellwelt bestimmt als auch durch die Sensorik gemessen. 
Die Differenz dieser beiden Bestimmungen der messbaren 
GroBen wird zu einem Fehlervektor gruppiert. Der Parame- 
tervektor wird durch geeignete Verfahren so eingestellt, daB 60 
der Fehlervektor minimal wird, d. h. so, dass die tatsachli- 
chen Messungen und die durch das Modell in Verbindung 
mit dem aktuelien Parametervektor bestimmten GroBen 
moglichst gut iibereinstimmen. 

In der Fig. 4 beschreibt der Punkt C das Projektionszen- 65 
trum durch welches alle AbbildungssU-ahlen des Sensors 2 
verlaufen. Die Senkrechte zur Bildebene durch das Projekti- 
onszentrum C wird als optische Achse (Z-Achse) bezeich- 
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net. Die Z- Achse schneidet eine Bildebene B im Bildhaupt- 
punkt Pbh- Der Bildhauptpunkt Pbh hat in dem durch Bild- 
zeiien und -spalten aufgespannten Rechnerkoordinatensy- 
stem die Koordinalen (x_r, y_r) entsprechend (x_h, y_h). 
DieX- und Y-Achsedes Kamerakoordinatensystems verlau- 
fen dabei parallel zu den Achsen des Rechnerkoordinatensy- 
stems. Als Kammerkonstante c wird hier der Abstand des 
ProjektionszenUiims vom Bildhauptpunkt Pbh, dividiert 
durch den Abstand zwischen zwei Bildpunkten einer Bild- 
spalte, bczeichnet. SchlieBlich wird das Verhaltnis des Ab- 
standes zweier Bildpunkte innerhalb einer Bildspalte zum 
Abstand innerhalb einer Bildzeile als Achsenverhaltnis s be- 
zeichnet. Fiir das Lochkameramodell nach der Fig. 4 bilden 
die vier genannten Parameter (x_h, y__h, c, s) die sog. intrin- 
sischen Parameter der Kalibriemng, Damit kann die Projek- 
lion eines Objektpunktes Pq auf die Bildebene (Bildpunkt 
Pb) nach der folgenden Beziehung angegeben werden: 

x_r = x_h + s • c • XyZ 
y-.r = y_h + c Y/Z (1) 

Es wird hier weiterhin angenommen, dass fur die Kamera 
(Sensor 2) ein einfaches Lochkameramodell nach der Fig, 4 
zugrunde liegt, dessen inoinsische Kalibrierung die Parame- 
ter Bildhauptpunkt Pbh> Kammerkonstante c und die Bild- 
achsenskalierung umfasst. Fiir den Radarsensor 3 sollen zu- 
satzlich der Verschiebungsvektor T und die Rotation R zwi- 
schen Radarkoordinatensystem und Kamerakoordinatensy- 
stem kalibriert werden. Damit ergibt sich der Zusammen- 
hang zwischen dem Kamerakoordinatensystem (X, Y, Z) 
und dem Radarkoordinatensystem (X_R, Y_R, Z_R) zu: 

(X,Y,Z) = R ((X_R,Y_R,Z_R)-T) (2) 

Die Kalibricrungsparameler der Sensoren 2 und 3 bilden 
dann den gesuchlen Kalibrierungsvektor p_k. 

Als messbare GroBen werden z. B. von der Kamera (Sen- 
sor 2) die Bildkoordinaten ruhender charakterislischer 
Punkle an Objeklen 6 (Ecken, o. a.) und vom Radarsensor 3 
die Entfemung, Winkel und Relativgeschwindigkeit von ru- 
henden Objeklen 6 im Radarkoordinatensystem bezeichnet. 
Die geometrischen Parameter, aus denen sich messbare Gro- 
Ben mit Hilfe der Kalibrierung anhand des Abbildungsmo- 
dells nach der Fig, 4 bestimmen lassen, werden hier als Mo- 
dellparameter p_m bezeichnet. Fiir das gewahlte Beispiel 
sind dies die (Kamera-)Kooidinaten der charakteiistischen 
Punkte sowie die Koordinaten und die Relativgeschwindig- 
keit von Objeklen, Das Abbildungsmodell ist fiir die Ka- 
mera (Sensor 2) durch die Gleichung (1) und fiir den Radar- 
sensor 3 durch die Gleichung (2) gegeben. Die Modellpara- 
meter p_m bilden gemeinsam mit den Kalibrierungsparame- 
tem p_k den Parametervektor p (vgl. Block 26 aus der Fig, 
2). 

Nach dem Flussdiagramm aus der Fig. 3 wird zunachst 
der Parametervektor p initialisiert (Block 30), z. B. wird der 
Bildhauptpunkt Pbh willkiirlich auf den Bildmittelpunkt ge- 
setzt, als Kammerkonstante c und Achsenverhaltnis werden 
die groben Werle, wie sie beispielsweise der Kameraherstel- 
ler angibl, VCTwendeL Der Verschiebungsvektor T und der 
Rotationsvektor R werden grob, beispielsweise mit einem 
Metermafi, vermessen. Da bislang weder charakteristische 
Bildpunkte noch Objekte vermessen wurden, enthalt der 
Modellparametervektor p_m noch keine Parameter und die 
Menge der messbaren GroBen wird als leer initialisiert. 

In einem weiteren Schritt werden von den Sensoren 2 und 
3 Messungen durchgefuhrt (Block 31), wobei insbesondere 
die in zeillich vorhergehenden Messungen bereits ermittel- 
len messbaren GroBen in Block 32 wieder gesuchl werden, 
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sog. Tracking. Die aktuell bestehende Menge raessbarer 
GroBen wird dann nach Block 33 um neu hinzugekommene 
messbare GroBen, wie z. B. um neu ins Bild gekonimene 
charakterislische Punkle, erweitert. Die beim sogenannlen 
Tracking nicht wieder gefundenen messbaren GroBen wer- 5 
den dabei aus der Menge der messbarer GroBen entfemt. 

Fiir alle messbaren GroBen werden die Modellparameter 
p_m und die Fahrzeugeigenbewegung zum voriierigen MeB- 
zeitpunkt mil den zugehorigen Konfidenzintervalien mittels 
an sich bekannter Standardmethoden bestimmt. Nachdem 10 
beispielsweise ein charakteristischer Objektpunkt Pq das er- 
ste Mai gemessen wurde, umfasst das Konfidenzintervall 
dabei noch mindestens eine Gerade. Nach mehrmaligem 
Vermessen derselben charaktmstischen Objektpunkles Pq 
aus unterschiedlichen Positionen lassen sich die Modellpa- 15 
rameter p_m und die Fahrzeugeigenbewegung zunehmend 
genauer vermessen, so dass das entsprechende Konfidenzin- 
tervall kleiner wird. Objektpunkte Pq mil kleinem Konfi- 
denzintervall und zeitlich stabilen Koordinaten werden als 
zu ruhenden Objeklen 6 gehorig gekennzeichnet und in den 20 
Modellparametervektor aufgenommen. Umgekehrt werden 
Punkte, die nicht oder nicht mehr ruhen aufgrund verander- 
licher Koordinaten, aus dem Modellparametervektor ent- 
femt. Analog wird die Fahrzeugeigenbewegung mittels ra- 
busten Schatzverfahren aus den vom Radarsensor 3 vermes- 25 
senen Relativgeschwindigkeiten aller Objekte 6 ermittell 
und nur die Objekte, die sich mit dieser Relativgeschwindig- 
keit bewegen, werden als ruhend akzeptiert und ihre Posi- 
tion dem Modellparametervektor zugeordnet. 

Im Gegensalz zu Verfahren aus dem Bereich des sog. ak- 30 
tives Sehens ist fur die anhand des Ausfuhrungsbeispiels be- 
schriebene Erfindung somit keine gezieltc Bewegung des 
Fahrzeugs 1 notwendig, sondem es wird die vorhandene Be- 
wegung des Fahrzeugs 1 ermittelt und ausgenutzt. Mit Hilfe 
der oben aufgestellten Abbildungsgleichungen (1) und (2) 35 
werden dann die messbaren GroBen aus der Modellwelt aus 
dem Parametervektor p nach Block 34 aus der Fig. 3 ermit- 
telt. Die DifFerenz zwischen dem Wert der messbaren Gro- 
Ben aufgrund der Sensorraessung und der Modellierung 
wird als Fehlervektor bezeichnet (Block 35), wobei auch der 40 
Fehlervektor von den Kalibrierungsparametem abhangig ist, 
da die modellierten Werte von der Kalibrierung abhangen. 

Duich eine schon erwahnte Ausgieichsrechnung kann 
nun der Parametervektor p nach Block 36 so variiert wer- 
den, dass der Fehlervektor kleiner wird, z. B. durch ein Le- 45 
ast-Square- Verfahren. AnschlieBend konnen neue Messun- 
gen der Sensoren 2 und 3 hinzugefugt werden, so dass sich 
insgesamt ein iteratives Kalibrierungsverfahren ergibt 
(Block 37). Bei der Durchfiihrung der beschriebenen Ver- 
fahrensschritte stellt sich dabei eine relativ schnelle Konver- 50 
genz der Kalibrierungsparameter auf fur eine geometrische 
Vermessungen gute Werte heraus. Besonders gunstig ftir die 
Qualilat der Kalibrierung ist dabei die Zugrundelegung der 
Rolationsbewegungen des Fahrzeugs 1, wie sie in der Praxis 
durch Nickbewegungen oder durch Kurvenfahrten auflre- 55 
ten. 

Patentanspriiche 

1. Verfahren zur Kalibrierung eines Sensorsystems, eo 
mit dem eine Erfassung und Auswertung von Objektcn 
im Kursverlauf eines Fahrzeuges (1) durchgefuhrt 
wird, bei dem 

~ mit dem Sensorsystem (2, 3, 4, 5) charaklcristi- 
sche Daten der Objekte (6) erfasst werden und die 65 
Daten, die unter Beriicksichtigung der Eigenbe- 
wegung des Fahrzeugs (1) als ruhende oder quasi 
ruhende Objekte (6) erkannt werden, einer Kali- 
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brierungseinheit (7) zugefiihrt werden und bei 

dem 

- die Abweichung der aktuell gemessenen Daten 
von Daten eines Modells der Objekte (6) als Feh- 
lervektor ermittelt (25; 35) und zur Korrektur der 
Daten des Modells in Richtung auf eine Minimie- 
rung der Abweichung herangezogen wird (27, 26; 
36, 37) 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass 

- nach einer Initialisierungsphase (30) mit vor- 
gebbaren Parametem eine erste Erfassung (20, 21; 
31, 32) der Objektdaten vorgenommen wird, die 
als Modelldaien gespeichert werden (22; 33) und 
dass 

- in alien zyklisch darauf folgenden Messungen 
die jeweils aktuellen Objektdaten mit den zuvor 
erfassten gespeicherten Modelldaten zur Gewin- 
nung des jeweiligen Fehlervektors in der Kalibrie- 
rungseinheit verarbeitet werden (25, 26; 34, 35). 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
net, dass 

- wahrend der Verarbeitung der Daten in der Ka- 
librierungseinheit (7) die jeweils in den vorheri- 
gen Messungen gewonnenen Objektdaten ausge- 
wahlt werden, wobei nicht wieder gefundene Ob- 
jektdaten gel5scht und jeweils neu hinzugekom- 
mene Objektdaten aufgenommen werden und 
dass 

- die Objektdaten, die nach mehrmaligen Mes- 
sungen aus unterschiedlichen Positionen des 
Fahrzeugs (1) heraus eine Verkleinerung des je- 
weiligen Konfidenzintervalls aufweisen, als zu ei- 
nem ruhenden oder quasi ruhenden Objekt (6) ge- 
horenden Daten gekennzeichnet werden. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass 

- aus aufeinanderfolgenden Objektdaten eine 
ubereinstimmende Relativgeschwindigkeit von 
Objekten und daraus die Eigenbewegung des 
Fahrzeugs (1) ermittelt wird und dass 

- die Objektdaten, die einem Objekt (6) mit die- 
ser gleichen Relativgeschwindigkeit zuzuoidnen 
sind, als zu einem ruhenden oder quasi ruhenden 
Objekt (6) gehorenden Daten gekennzeichnet 
werden. 

5. Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, dass 

- als Eigenbewegung des Fahrzeugs (1) eine Ro- 
tationsbewegung des Fahrzeuges (1) durch Nick- 
bewegungen und/oder durch Kurvenfahrten her- 
angezogen wird. 

6. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass 

- das Sensorsystem ein Bildaufnahmesystem als 
Sensor (2) beinhaltet, bei dem mittels einer elek- 
tronischen Kamera mit nichtlinearer Wandler- 
kennlinie in den Aufnahmeintervallen jeweils se- 
riell Bildpunkte erfasst und ausgewertet werden. 

1, Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, dass 

- die Ergebnisse der Kalibrierung eines Sensors 
(2) des Sensorsystems auf einen oder mehrere 
weitere Sensoren (3, 4, 5) am Fahrzcug (1) zur 
Kalibrierung auch dieser Sensoren ubertragen 
werden. 

8. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass 
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- fur den Fall, dass ein oder die Sensoren (2, 3, 4, 
5) des Sensorsystems widerspriichliche Messda- 
ten erstellen, eine Signalisierung an eine Aus- 
werteeinheil oder an den Fahrer des Fahrzeugs (1) 
erfolgt. 
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